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Sir: 

Prior to examination, please amend the above-identification as follows: 



Please amend the claims as follows: 
Clean Copy of Amended Claims 

3. Method according to claim 1, characterised in that attitude is integrated out via 
information about the body-frame angular rates (p, q and r) obtained from the aircraft- 
fixed angular rate gyros of the aircraft. 

8. Method according to claim 6, characterised in that in a second filter (22) is 
performed estimation of attitude errors and heading errors that arise on integration of the 
aircraft's body-frame angular rates (p, q and r) obtained from the aircraft's body-frame 
angular rate gyros, where the estimation is done with the aid of attitude calculated from 



PRELIMINARY AMENDMENT 



In the Claims: 



air data information as well as derived measured body-frame magnetic field vector 
components. 

9. Method according to claim 7, characterised in that the filtering takes place with 
the aid of Kalman filters. 

12. Arrangement according to claim 10, characterised in that integration routine (8) 
integrates out the aircraft's attitude from the aircraft's body-frame angular rates (p, q and 
r) obtained from the aircraft's body-frame angular rate gyros. 

24. Arrangement according to claim 1 6, characterised in that the first filter (11) 
and/or the second filter (22) consists of a Kalman filter. 

Claim Amendments 

3. (Amended) Method according to claim 1 [and 2], characterised in that attitude is 
integrated out via information about the body-frame angular rates (p, q and r) obtained 
from the aircraft-fixed angular rate gyros of the aircraft. 

8. (Amended) Method according to [claims 6 or 7] claim 6 , characterised in that in a 
second filter (22) is performed estimation of attitude errors and heading errors that arise 
on integration of the aircraft's body-frame angular rates (p, q and r) obtained from the 
aircraft's body- frame angular rate gyros, where the estimation is done with the aid of 
attitude calculated from air data information as well as derived measured body-frame 
magnetic field vector components. 

9. (Amended) Method according to [claims 7 or 8] claim 7 , characterised in that the 
filtering takes place with the aid of Kalman filters. 



12. (Amended) Arrangement according to claim 10 [or 11], characterised in that 
integration routine (8) integrates out the aircraft's attitude from the aircraft's body-frame 
angular rates (p, q and r) obtained from the aircraft's body-frame angular rate gyros. 

24. (Amended) Arrangement according to [any of claims 1 6 - 23] claim 16 , 
characterised in that the first filter (1 1) and/or the second filter (22) consists of a Kalman 
filter. 



Remarks 



Applicants have amended the claims to eliminate multiple dependencies. 
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Date: July / 6 , 2001 




Eric J. Franklin, Reg. No. 37,134 
Swidler Berlin Shereff Friedman 
3000 K Street, NW, Suite 300 
Washington, DC 20007 
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Redundant system for the i ndic ation of heading a nd attitude in anagrrgg^ 
TECHNICAL FIELD 

The invention relates to a system function which provides display of heading and attitude on 
displays in an aircraft, for example a head-up display (HUD), in the event of failures in certain 
equipment for normal attitude display. The system function, which in English is called 
Attitude and Heading Reference System and is abbreviated AHRS with reference to its 
initials, supplements the aircraft's normal display for heading and attitude. This display is 
intended to help the pilot to recover from difficult attitudes and then facilitate return to base/ 
landing. 

PRIOR ART 

In order not to lose attitude and heading display in an aircraft in the event of failure of a 
normally-used inertial navigation system (INS) a redundant system is required. In good 
visibility a pilot can fly by using the horizon as an attitude reference, but with great 
uncertainty as to the heading. In bad weather, in cloud and at night when the horizon is not 
visible, the pilot can easily become disoriented and thereby place the aircraft and him/herself 
in hazardous situations. 

AHRS systems calculate, independently of normal systems, attitude angles (pitch and roll) and 
heading. Such a system continuously displays the position to the pilot on a display in the 
cockpit. The need for a redundant system for attitude may be so great that an aircraft is not 
permitted to fly without one. 

Redundant systems in the form of an AHRS unit are available today. Such a unit contains 
among other things gyros which measure aircraft angle changes in pitch, roll and yaw. It also 
contains accelerometers and magnetic sensor. The accelerometers are used to establish a 
horizontal plane. The magnetic sensors are used to obtain a magnetic north end. This type of 
AHRS system in the form of hardware is costly and involves the installation of heavy, bulky 
equipment on the aircraft. To overcome this there is proposed in this description a synthetic 
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AHRS which uses sensors existing in the aircraft, which are not normally intended for AHRS 
calculation and which therefore partly have significantly lower performance, instead of 
sensors of the type included in an AHRS unit. 

The angles are calculated with the aid of existing sensors in the aircraft. The aim is to use 
existing angular rate gyro signals and support these with calculations based on other available 
primary data in the aircraft. Angular rate gyros are normally used in control systems and 
generally have substantially greater drift than gyros for navigation* 



DESCRIPTION OF THE INVENTION 

According to one aspect of the invention, a method is provided for synthetically calculating 
redundant attitude and redundant heading by means of data existing in an aircraft as specified 
in the claims. 

Different forms of embodiment have been developed. In one embodiment the heading of the 
aircraft is available and in another embodiment the heading is calculated on the basis of a 
magnetic heading sensor. When the heading is available the calculations can be substantially 
reduced. 

When the heading is available (redundant heading) attitude is calculated by weighting together 
the signals from the angular rate gyros in the flight control system of the aircraft, information 
from air data (altitude, speed, angle of attack) and information about heading (redundant 
heading). 

When the heading is not available, attitude and heading are calculated according to one 
embodiment with the aid of Kalman filters by weighting together the signals from the angular 
rate gyros in the aircraft's control system, information from air data (altitude, speed, angle of 
attack and sideslip angle) as well as information from an existing magnetic heading detector in 
the aircraft. 

One advantage of a synthetic AHRS according to the aspect of the invention is that it works 
out substantially cheaper than conventional AHRS system based on their own sensors if 
existing sensors in the aircraft can be used. This also saves space and weight in the aircraft. 
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DESCRIPTION OF FIGURES 

Figure 1 shows a schematic diagram of an AHRS function in which the heading is available. 

Figure 2 shows the principle for levelling of the attitude of the aircraft in a head-up display, to 
the left without levelling and to the right with levelling. 

Figure 3 shows the block diagram of a redundant system for both attitude and heading. 

Figure 4 shows in three pictures the attitude and heading of the aircraft and the axes in the 
body frame coordinate system, as well as the angle of attack and the sideslip angle. 

Figure 5 shows how zero errors and scale factor errors impact the measured value. 
DESCRIPTION OF EMBODIMENT 

A number of embodiments are described below with the support of the figures. According to 
the invention, methods are provided for synthetically calculating attitude and heading by 
means of data existing in the aircraft as specified in the claims. 

In a simpler embodiment, the heading of the aircraft is available. In another embodiment the 
heading is calculated, in this case on the basis of a magnetic heading sensor. 

Calculation of AHRS when the heading is known 

The signals from the three angular rate gyros 2 rigidly mounted on the body frame are used to 
determine the orientation of the aircraft relative to the reference coordinate system N 
(navigation frame). The angular rate gyros 2 measure angular velocities around the three body- 
frame coordinate axes (x, y, z). The angular velocities are normally designated 0> x or p 
(rotation around the x-axis), o> y or q (rotation around the y-axis) and or r (rotation around 
the z-axis). The orientation between the body-frame coordinate system B (body) and the N 
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system is given by the euier angles 9, § and However, since the heading is known, only 8 
and <j> are of interest. With the assumption that the N system is an inertial system and is 
oriented so that its z-axis is parallel to the g vector of the earth, it can be shown that 



e 






1 



oo y cos<j) - cousin $ 
G>_4- tan6(co y sin(t> + accost 



(1) 



If the gyros 2 were ideal, the initial values <j> 0 and 8 0 were error-free and if the integration 
method used were accurate, attitude angles can be obtained by solving Eqn (1). In practice, 
however, none of these preconditions is satisfied; instead, sensor errors etc cause the solution 
to diverge and relatively soon to become unusable. 

Sensor errors in the form of among others zero errors, scale factor errors, misaligned mounting 
and acceleration-induced drifts constitute the dominant sources of error. In level flight the zero 
error is the error source that dominates error growth. 

Owing to sensor imperfections and uncertainty in initial values, equation (1) gives an estimate 
of roll and pitch angle derivatives according to 



co y cos$- cousin cj) 
co^-f tan8(<a y sm$ + G) 2 cos$) 



(2) 



The difference between the expected tpAHRS (calculated by the AHRS function) and the 
"actual" (p ref (from air data, primary data calculated) attitude angles constitutes an estimate of 
the attitude error 



A<p = q>AHRS - 9ref 

See below concerning the use of Aq>. 



(3) 
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<?AHRS = j\yyt + <po-lim(A<p) (4) 

t 

where <po constitutes estimated initial values. 
Calculation of <p re f 

The formula 9 ref ^ arcsin (A/v t ) + (a * cos (j>) is used when calculating 8^. ft is a high-pass- 
filtered altitude signal. v t is true airspeed. 

The formula $ re f = arctan (v t * (y)fg) is used when calculating (j)^. 
^ is a high-pass-filtered heading (redundant heading) signal. 



Zero correction of the angular rate gyros 

The zero errors in the angular rate gyros 2 are heavily temperature-dependent. It may take 20 
to 30 minutes for the gyros to reach operating temperature. This means that an INS failure 
shortly after take-off might give large zero errors if flying continued. However, it takes a 
certain time from gyros 2 receiving voltage to the aircraft taking off, which means that part of 
the temperature stabilisation has been completed when a flight begins* It is also assumed that 
landing can take place within a short time in the event of an INS failure during takeoff. To 
minimise zero errors from the angular rate gyros 2 a zero correction of the angular rate gyros 
is performed by software. This involves comparing the co (p, q and r) signals from the angular 
rate gyros 2 with the corresponding signal from the INS, see eqn (5), by generating a 
difference in 4a. The difference is low-pass-filtered in a filter 5 and added to the angular rate 
gyro signals in a difference generator 4b, where the signal o\ which designates the zero-error- 
corrected gyro signals and is used instead of © in the AHRS calculations. This is done 
continuously as long as the INS is working. In the event of an INS failure the most recently 
performed zero corrections are used for the rest of the flight 
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Qtns 






/TOT 





(5) 



A block diagram of the realisation of the AHRS function with zero correction of the angular 
rate gyros is shown in Figure L The figure gives a schematic illustration of the AHRS 
function. The zero correction of the angular rate gyros is performed by the units inside the 
dashed area D. 

¥tns> 8 tos and c^s are high-pass-filtered to obtain ^TNS » ®TNS §TNS- These are used 
in Eqn (5), which gives Op^s ( Ptos> <1tns» r TNs) ^ a block 1. co ( p, q, r) which are 
obtained as signals from the gyros designated by 2 are low-pass-filtered in a low-pass filter 3, 
before the difference is generated in 4a. 

The difference signal between the co^s ( p^S' <JiNS> r TNs) signals and the o ( p, q, r) signals 
is low-pass-fiitered with a long time-constant in a low-pass filter 5, ie its mean value is 
generated over a long time. The filter 5 is initialised at take-off rotation with the shorter time- 
constant. After a power failure, the filter 5 is initialised instantaneously. 



In block 7, 9 is calculated, after which the integration according to Equation (4) is performed 

in an integrator 8, to which the initial conditions <po are added. In a difference generator 9a 
the signal Acp is added, but is disconnected by means of a switch 9b under certain changeover 
conditions, as for example when (7) > y LI M ^d |<f>] > <J>um- T& e ^9 signal passes through a 
limiter 9c. The magnitude of the output signal from the limiter 9c is dependent on the 
magnitude of the A9 signal (ie the input signal to limiter 9c). The A9 signal is generated 

according to Equation (3) in a difference generator 9d to which are added calculated (pAHRS 
attitude angles and "actual" 9^ attitude angles from sensors (primary data) designated with 
9e. 



Despite compensations, the calculated angles from the AHRS contain minor zero errors. Since 
the output signals are used for head-up display, this is corrected by using A$ in roll and A9 in 
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pitch to level the SI image until a stable position is obtained. See Figure 2, where the line H 
symbolises the actual horizon and where an aircraft is represented by P. Note that this levelling 
of die HUD only takes place when one is within the limits described above. 

AHRS calculation when the heading is also to be calculated 

Figure 3 shows schematically the modules that form building blocks for another variant of a 
synthetic AHRS and how these modules are linked together to create a redundant attitude and 
a redundant heading. 

Figure 3 shows the principle of the redundant system in accordance with the aspect of the 
invention. The system consists of two subsystems A and B; the first subsystem A performs 
estimation of any errors in the measured geomagnetic field and the other subsystem B 
performs calculation of redundant attitude and heading. In all, this results in five building 
blocks, where a first measurement routine 10 and a first Kalman filter 11 constitute the 
building blocks in the first subsystem A and further where the integration routine (1/s) 20, 
measurement routine 21 and a second Kalman filter 22 constitute the building blocks in the 
second subsystem B. 

With measurement routine 10, measured field vector components in the body frame coordinate 
system are transformed, to a north-, east- and vertically-oriented coordinate system called the 
navigation frame. The transformation takes place with the aid of attitude and heading from the 
inertial navigation system of the aircraft, INS, via wire 12. The field vector components of the 
geomagnetic field are taken from a magnetic heading sensor in the aircraft and arrive via wire 
13. In the first Kalman filter 11, the errors in the field vector components are then estimated on 
the basis of knowledge about the nominal nature of the components, after which the estimated 
values are stored in a memory 14. 

Subsystem A (measurement routine 10 and Kalman filter 11) are used only when the INS is 
working correctly. In the event of INS failure, the latest possible estimate of the errors in the 
field vector components is used, ie that which has been stored in memory 14. Since it may be 
difficult in many cases to decide whether the INS is working as it should, the absolutely last 
estimate should not be used. In order to solve this, the estimates of errors in the measured 
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geomagnetic field that are used are at least one flight old. ie the estimates that are stored in the 
memory from the previous flight or earlier. 

The integration routine 20 receives information about angular velocities, in this case for the 
three coordinate axes x, y and 2 in the body frame* These are normally designated co^ or p 

(rotation around the x-axis), or q (rotation around the y-axis) and © z or r (rotation around 

the z-axis). The information is taken from the angular rate gyros of the control systsm and is 
fed via wire 15 to routine 20 which integrates out attitude and heading via a transformation 
matrix. 

The second measurement routine 21 consists of a developed variant of the first measurement 
routine 1 1 and uses the field vector components derived from the first measurement routine 
1 L In addition, a roll and pitch angle are calculated with the aid of data from existing air data 
and existing slip sensors, data which arrives to measurement routine 21 via wire 16 to 
measurement routine 21. By means of the second Kalman filter 22 the attitude and heading 
errors that arise on integration of the angular rate gyro signals of the control system are 
primarily calculated. Secondarily, Kalman filter 22 is used to estimate the biases in the angular 
rate gyros, ie the biases in p, q, and r. 



The first measurement routine 10 

The geomagnetic field can be calculated theoretically all over the world To do this, the IGRF 
(international Geomagnetic Reference Field) is used, for example. 
The field vector in the body frame is designated here with B B and the field vector in the 
navigation frame with B N . Further, the three components of the field vector are designated in 
accordance with 

B = lB#B r Bf . (6) 

With the aid of the transformation matrix which transforms a vector from body frame to 
navigation frame, we have 
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where has the appearance 



c n c 12 c 13 

c 21 c 22 c 23 
c 3l c 32 c 33 



(8) 



The transf ormatioti matrix is calculated with the aid of attitude and heading, 0, <j>, \|/, from 
the INS. 

The difference between a measured field vector and a field vector calculated in accordance 
with the model will be 

B V y measured ~ B N, calculated = ^ * $ B B 

where S designates the difference between the measured and the calculated quantity, 
The left-hand part of Eqn (9) becomes the output signal from the first measurement routine 10 
and thus the input signal to Kalman filter 1 L Further, the right-hand part of Eqn (9) is used in 
Kalman filter 11, which is evident from the description of the first Kalman filter 1 1 below. 



The first Kalman filter 11 
Given the state model 

+ i 35 F k*k + ™k (1Q) 
a Kalman filter works in accordance with: 



Time updating 

where P' k + x is the estimated uncertainty of fee states after time updating. 



9 
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Measurement updating 

T T -1 

where P£ + x is the estimated uncertainty of the states after measurement updating. 



(12) 



The errors in the field vector components are modelled according to 



SB, 
81?, 



s x ^xy ^xz 

k s k 
*~yx *y "-yz 

fizx &zy s zj 



(13) 



where b are biases, s are scale factor errors and k is a cross-coupling from one component to 
another (for example, index xy refers to how the y-component affects the x-component). These 
12 errors can represent the states in the first Kalman filter 1 1 according to 



x k \b x by &z s x s y s z ^xy ^xz ^yz ^yx ^zx & J 
and each of the state equations looks like this 



(14) 



(15) 



where the index k designates the time-discrete count-up in time. 

In Eqn (15), w k is a weakly time-discrete process noise to model a certain drift in the errors. 
Eqn (15) means that the prediction matrix becomes the unit matrix and the covariance matrix 

for the process noise will be the unit matrix multiplied by o w , where a w is typically set to 
one hundred-thousandth (dimensionless since the field vector components are normalised to 
the amount 1 before they are used). 



Where measurement updating of Kalman filter 1 1 is concerned, Eqn (9) is used and the 
measurement matrix looks like this 



c \\ C 12 C 13 c ll B x c l2 B y c l3 B z c U B y c ll B z c l2 B z C \2 B x c l3 B x c \3 B y 
c 2l c 22 c 23 c 2l B x c 22 B y c 23 B z C 2l B y c 2\ B z c 22 B z C 22 B x c 23 B x C 23 J 
531 c 32 c 33 c 31 B x c 32 B y c 33 B z c 3l B y c 3l B z c 32 B z c 32 B x c 33 B x c 33 B y_ 



(16) 
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Owing to unmodelled interference, the measured geomagnetic field vector will deviate from 
the model, both in direction and in amount The simplest variant is to model this interference 
as a constant white measurement noise with the aid of the measurement noise covariance 
matrix The standard deviations for the measurement noise for the three field vector 
component measurements are each typically set to one-tenth (dimensionless because the field 
vector components are normalised to 1 before they are used). 

A Chi2 test is used to avoid the impact of bad measurements. In addition, the measurements of 
the field vector components are not used if the angular velocities are too high. The reason for 
this is that various time delays exert an effect at high angular velocities. 



Integration routine 20 

It can be shown that the time-derivative of the transformation matrix becomes 

Cb = C%'W IB -W [pr C%. (17) 
In Eqn (17) Wjg and are, respectively, B's (body frame) rotation relative to I (inertial 
frame) and N*s (navigation frame) rotation relative to L Both are written in matrix form. 
Since we are concerned with redundant attitude and redundant heading, where the 
requirements for attitude errors are of the order of 2 degrees, whilst the elements in Wjjq are of 

the order of 0.01 degrees, W lN is disregarded. The expression in (17) will then be 

Cb = cj- W IB , (13) 

where W [B is the angular rate gyro signals from the angular rate gyros of the control system. 

In principle Eqn (18) means that there are nine differential equations. Because of 
orthogonality, only six of these need be integrated and the other three can be calculated with 
the aid of the cross-product. 



11 
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The second measurement routine 21 



The second measurement routine 21 consists of a developed variant of the first measurement 
routine 1 1, in which the expansion consists of calculating the roil and pitch angles with the aid 
of data from air data (altitude and speed) and the slip sensors (angle of attack and sideslip 
angle). 



In the first measurement routine 1 1 it is assumed that only the field vector components are 
incorrect and that attitude and heading are correct. This assumption is reasonable because the 
field vector components are resolved with the aid of attitude and heading from the INS. In the 
second measurement routine 21 this is not satisfied, and consideration must also be given to 
attitude and heading errors. The field vector used in the second measurement routine is 
compensated for errors estimated in subsystem A. 

Errors in both the field vector and the transformation matrix mean that 

B N, Measured = Cb * 5 B, Measured 
~ N 

where Cb stands for calculated transformation matrix and means that 

CU(? B + 8(? B . (20)- 
If we use (20), generate the difference between measured and calculated field vector and 
disregard error products, we get 

B N t Measured " B N, Calculated ~ ' B N, Measured + ^ B ' § B B • ( 21 ) 

In the second measurement routine 21, roll and pitch angle are calculated with the aid of 
altitude, speed, angle of attack and sideslip angle. The pitch angle can be calculated according 
to 

Q ref = + cos(<j>)a + sin($)P ( 22 ) 

To be able to calculate the pitch angle according to the expression in Eqn (22) an altitude 
derivative is required. This altitude derivative is not directly accessible and must instead be 
calculated on the basis of existing altitude which is obtained from air data. The calculation is 
done according to 
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(23) 



ie a high-pass filtering of the altitude. The symbols x and f s in Eqn (23) represent 

respectively the time-constant of the filtering and the sampling frequency. The speed v used in 
Eqn (22) is approximately v, (true speed relative to the air). By approximately we mean that, 

when calculating y r , measured temperature is not used, which is the normal case, but a so- 
called standard temperature distribution is used here instead. 

Further, the roll angle can be calculated according to 



The expression in Eqn (24) applies only for small roll and pitch angles, small angular 
velocities and moreover when the angles of attack and the sideslip angles are small. 

The above two expressions are calculated and compared with the attitude that is calculated via 
the integration routine by generating the difference according to 



(24) 



<j>-4> ref = atan atan 

c 33 




(25) 



where 



(j> = atan 




9 = atan 




(26) 
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The second Kalman filter 22 

The second Kalman filter 22 can be said to be the heart of the system. Here are estimated the 
attitude and heading errors that arise on integration of the angular rate gyro signals from the 
flight control system. Also estimated are the zero errors in the field vector components of the 
angular rate gyro signals. Further, possible residual errors in the field vector components, ie 
the errors that the first Kalman filter 1 1 cannot reach are estimated here. All in all, this means 
nine states: three for attitude and heading errors, three for the zero errors in the angular rate 
gyro signals and three for residual errors in the field vector components (three zero errors). 
Attitude and heading errors are represented by a rotation of the body-frame system from a 

calculated to a true coordinate system. The error in can be written 



sc£ = cS-cJ = <? B *d-dl = c£.(c?-j). (27) 

One can ascertain that 



B 



1 -y z y y 



= r + 7, (28) 



T 

where T is the matrix form of y = [J x , J y , YJ and I is the unit matrix (T means transponate). 

The elements of the vector y describe a small rotation around the respective axis between 
actual (true) and calculated body frame system. The corresponding differential equations for 
the elements of y can be derived to 

y=So>, (29) 

where 8 go is the errors in the angular rates from the angular rate gyros. 

The errors in the angular rates are modelled as three first-order Markov processes according to 

= -i-5a) + Mco ' (30) 



w © 

where the time-constant x w is set typically to a number of hours and the three to typically 
less than one degree/second. 

Residual errors in the field vector components are modelled (the zero errors) in a similar way, 
ie 



14 



WO 00/42432 



PCT/SEOO/00034 



h = -L b + u b (3D 

where z b is set typically to a number of hours, and u b is set typically to a few hundredths 
(dimensionless because the field vector components are normalised to 1 before they are used). 

This gives a state vector according to 

** = [( x T y y z S0>x S<0 y 5e >2 b x b y b 1 (32) 

and a prediction matrix according to 
t + &r 

F k = 1+ J A(x)<fr, (33) 

where A(x) is the matrix that described the time-continuous state equations as above. 
The covariance matrix for the process noise is set to a diagonal matrix. Among other 
things, and u b described above are used as diagonal elements. As regards the diagonal 
elements linked to the states for attitude and heading errors (the first three), the effects of the 
scale factor errors in the angular rate gyros are included. These scale factor errors are normally 
of the order of 2% and can cause major errors in integrated-out attitude and heading at high 
angular rates. 

The. measurements are five in number: three derived field vector components and roll and pitch 
angle calculated from air data. These measurements are obtained by using the relations (21) 
and (25). 

As regards the measurement matrix H k , relation (21) is used to fill out the three top lines. This 
results in the three top lines of the matrix having the appearance 



(34) 



For the last two lines of H k Eqn (25) is used, by differentiating the two right-hand parts with 
respect to all states in the second Kalman filter 22. As a result, the last two lines get the 
elements (the index designates row and column in that order) 









H k,l-3 - 










c l2 B z 




c l3 B x c l2 B x~ 


c n B y 0 0 0 c n 


c 12 


c 13 


c 23 B y~ 




c 2l B z - 


c 23 B x c 22 B x~ 


c 2l B y 0 0 0 c zx 


c 22 


c 23 


c 33 B y - 


c 32 B z 




c 33 B x c 32 B x~ 


c 3l B y 000c 31 


c 32 


c 33 
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VgC^^y ~ C 32 (0 Z )( C 11 + C 2I> 
g\c 2 U + 4l) 2 + A c 33 • <»; + c 32 • %) 



h 42 = 



^43 = 



2vg(- c n c l3 - c 21 c 23 )(c 33 CD z + c 32 G) y ) - vg(Q z c 31 (c 2 t + c 2I ) c 31 c 32 

■ 2 



S~( C U + c 2l)" + v "( c 33 * + c 32 * °V> C 32 + C 33 

2vg(g n gi2 + g21 c 22)( c 33<°t + C 32<°y) + Vg<V?3l( c ll + C lp C 31 C 33 

2 2 2~2 2 2 ^ ° 

2 ( c ll + c 2l) + v ( c 33 * <° Z + c 32 ' m y) 



c 32 + c 33 



(35) 



^45 = 



&46 = 



2 2 

vgc 32 (c n + c 21 ) 



g 2 (c 2 u + c\ x ) 2 + v 2 (c 33 • co z + c 32 • co y ) 2 



^33( C 11 + C 2l) 



g 2 (c 2 n + c 21 ) 2 + v 2 (c 33 • 0), + c 32 • CD ? ) 2 



and 



^51 = 



h 52 = 



sin^atan^joc- cos^atan^^p 
, C33 + f-sin(atan^|a + cosf atan^V) 



(36) 



^53 = - 



The remaining elements in the fourth and fifth line are zero. 

The simplest choice for the covariance matrix for the measurement noise R k is a diagonal 
matrix. The first four measurement noise elements have a standard deviation which is set 
typically to one-tenth. The fifth measurement noise element on the other hand has a standard 
deviation that is set to a function of the altitude derivative and the speed. The function is quite 
simply a scaled sum of the expression for calculating pitch angle and according to Eqn (25) 
differentiated with respect to the altitude derivative and the speed. The function is set to 

(37) 

and gives a measure of the sensitivity of the pitch angle calculation to errors in the altitude 
derivative and the speed. 

Since the errors in attitude and heading calculated with the aid of the integration routine grow 
rapidly, estimated attitude and heading errors must be fed back to the integration routine, 



= 5 • 


ay 


+ 50- 


ae ref 








dv 
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which is done with wire 17. If this is not done, the error equations in the second Kalrnan filter 
22 rapidly become invalid by reason of the fact that the equations are fundamentally non- 
linear, in addition, the estimates of the zero errors in the angular rate gyros are fed back via a 
wire 18. This results in better linearisation of the second Kalman filter 22 and furthermore the 
sampling frequency f s can be kept down. 

In some flying situations the calculations that are performed in the second measurement 
routine 21 are inferior, either because the measurement equations are not sufficiently matched 
or because the measurement data is inherently poor. Calculation of the roll angle from air data 
is used only in level flight No measurement is used if the angular rates are not sufficiently 
small, typically a couple of degrees or so per second. The measurement residuals are also 
checked, where the measurement residuals are not allowed to exceed typically one to two 
times the associated estimated uncertainty. 

Symbols 

Coordinate systems 

I (Inertial frame): a system fixed in inertial space. 

When flying above the surface of the earth it is customary for the centre of this system to 
coincide with the centre of the earth. This is really an approximation, since a system fixed in 
inertial space must not rotate. Because the earth rotates around the sun, the I-system will also 
rotate. However, the error that arises is negligible. The accelerations and angular rates 
measured by the sensors in an inertial navigation system are relative to that system. 
N (Navigation frame): a system with its centre in the aircraft and with its xy plane always 
parallel to the surface of the earth. 

The x-axis points to the north, the y-axis to the east and the z-axis vertically down towards the 
surface of the earth. 

B (Body frame): a system in the aircraft, fixed to the body frame* 

This coordinate system rotates with the aircraft. The x-axis points out through the nose, the y- 
axis through the starboard wing and the z-axis vertically down relative to the aircraft. 
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Table 1 Explanation of designations (symbols) for angles and angular rates. 
See also Figure 4. 



4> 


Angle between y B and the horizontal plane, tilted by the 
angle 8 along x B (roll angle). 




Initial value for the roll angle and estimated roll angle, 
respectively 


<?>ref 


Roll angle calculated with the aid of data from air data 
and the heading derivative 


e 


Angle between x g and the horizontal plane (pitch angle). 


9 0 , S 


Initial value for the pitch angle and estimated pitch angle, 
respectively 


6 rcf 


Pitch angle calculated with the aid of data from air data 
and the slip sensors 


en = \4> ei r 


Comoressed svmbol for roll anffle and nitch an<*le 


9, <p 0 ,A<p 


Respectively: estimated roll and pitch angle, estimated 
initial values for roil and pitch angle and difference 

between inte?rrated-out and refarence-cal filiated roll and 
pitch angle 


<Pref> <PAHRS 


Respectively: roll and pitch angle calculated with the aid 
of air data and primary data, and integrate d-out roll and 
pitch angle, where integration is done with the aid of the 
angular rate gyro signals 


T * T 


Respectively: angle between the projection of x$ in the 
horizontal plane and north (heading angle), and discrete 
indexing of heading angle 


a 


Angle between air-related rate vector projected on the z- 
axis in body frame and projected on the x-axis in body 
frame (angle of attack) 


P 


Angle between air-related velocity vector and air-related 
velocity vector projected on the y-axis in body frame 
(sideslip angle) 




Transformation matrix (3x3 matrix) which transforms a 
vector from body frame (actual) to navigation frame. The 
elements of this matrix are designated c 11? c 12 , c 13 , c 2 i> 
c 22> c 23* c 3i» c 32» c 33» where the index designates row and 
column in that order 




Transformation matrix which transforms a vector from 
body frame (calculated) to navigation frame 
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Table 1 Explanation of designations (symbols) for angles and angular rates* 
See also Figure 4. 







Difference between calculated and true 




t/ 


Rotation around, respectively, the x-, y- and z-axis in 
hodv frame corresnondino' to the error between true and 
calculated body frame 


r 




Anti-wmmetrical matrix form of the vector v 


co /s = CO = 




Angular rate around, respectively, the x-, y- and z-axis in 

W\J\^y XX qqilW \^CXXX£^ LiKXX X ulU gjrJlW ijXgilQia y« lxivoC CxlX^ ulXwJL 

components are customarily also designated (p, q, r) 






The vector co IB expressed in anti-symmetrical matrix 

XU1UU 


5© = (Sco^ B(£> r 5cd z ) t 


Difference between actual and measured angular rate 
around, respectively, the x-, y- and z-axis in body frame 






Rotation of navigation frame relative to inertial frame that 
occurs when moving over the curved surface of the earth. 
Anti-symmetrical matrix form 


Table 2 


Explanation of symbols for the geomagnetic field. 


B^ B y , B 2 




Geomagnetic field vector components' in body frame 


5B ;c ,8S y ,8B 2 


Difference between measured and actual field vector 
components in body frame 


B N ,B B 




Geomagnetic field vector in navigation frame and body 
frame, respectively 


Table 3 


Explanation of symbols used in connection with filters 






Used as an index, and represent the instant before 
and after time updating, respectively 


n, n + 1 




Used to represent the present and subsequent 
sample, respectively 


-,+ 




Used as an index^ and represent the instant before 
and after measurement updating, respectively 






State vector, measurement vector and estimate 
uncertainty matrix 


w,<2 




Process noise vector and covariance matrix for 
process noise, respectively 
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Table 3 


Explanation of symbols used in connection with filters 


A,F 




Prediction matrix in time-continuous and time- 
discrete form 


K,H,R 




Kalraan gam matrix, measurement matrix and 
covariance matrix for measurement noise, 
respectively 






Driving noise for the Markov processes 


^co» ^' 


X V X 2 


Time-constants 


fs 




Sampling frequency 


Table 4 


Explanation of other symbols* See also Figure 5. 


^x* b z 




Bias (zero errors) 


s x , s y9 s z 




Scale factor errors 


k k k k k k 
""xy> *-xz> *-yx> "-yz? ^zx 9 zy 


Cross-connection errors (for example, index xy stands 
for how the y -component affects the ;c -component). 
Arise because the axes in triad are not truly orthogonal. 


h 9 h 




Altitude and low-pass-filtered time-derived altitude 
respectively 






True speed relative to the air 


g 




Gravity 
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CLAIMS 

1. * Method for synthetically calculating redundant attitude for an aircraft when the 
heading of the aircraft is known, with the aid of data existing in the aircraft, such as the 
angular rates p, q, r around the x-, y- and z- coordinates of an aircraft-fixed (body frame) 
coordinate system, air data information in the form of speed, altitude and angle of attack as 
well as heading information, characterised in that the method includes the steps: 

- attitude is calculated on the basis of the aircraft-fixed angular rates p, q, r and 

- the calculated attitude is corrected by means of air data and heading. 

2. Method according to claim 1, characterised in that the heading information is 
obtained from a heading gyro. 

3. Method according to claim 1 or 2, characterised in that attitude is integrated out via 
information about the body-frame angular rates (p, q and r) obtained from the aircraft-fixed 
angular rate gyros of the aircraft. 

4. Method according to claim 3, characterised in that correction of the integrated-out 
attitude takes place with the aid of attitude calculated on the basis of air data information and 
heading information. 

5. Method for synthetically calculating redundant attitude and redundant heading for an 
aircraft with the aid of data existing in the aircraft, such as the angular rates p, q, r around the 
x-, y- and z- coordinates of an aircraft-fixed (body frame) coordinate system, air data 
information in the form of speed, altitude and angle of attack, characterised in that the 
method includes the steps: 

- attitude and heading are calculated on the basis of the body-frame angular rates p, q, r 

- the errors in the measured body-frame magnetic field vector components are estimated, 

- the measured body-frame field magnetic field vector is derived, 

- errors in calculated attitude and heading are estimated with the aid of air data and derived 
measured body-frame magnetic field vector components and 

- the calculated attitude and heading are corrected by means of estimated errors in attitude and 
heading. 
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6. Method according to claim 5, characterised in that attitude andr heading are 
integrated out via information about the aircraft's body-frame angular rates (p, q and r) 
obtained from the aircraft's body-frame' angular rate gyros. 

7. Method according to claim 5, characterised in that estimation of errors in measured 
body-frame magnetic field vector components is performed in a first filter (1 1). 

8. Method according to claims 6 or 7, characterised in that in a second filter (22) is 
performed estimation of attitude errors and heading errors that arise on integration of the 
aircraft's body-frame angular rates (p, q and r) obtained from the aircraft's body-frame angular 
rate gyros, where the estimation is done with the aid of attitude calculated from air data 
information as well as derived measured body-frame magnetic field vector components. 

9. Method according to claims 7 or 8, characterised in that the filtering takes place 
with the aid of Kalman filters. 

10. Arrangement for synthetically calculating redundant attitude for an aircraft when the 
aircraft's heading is known, with the aid of data existing in the aircraft such as the aircraft's 
body-frame angular rates (p, q and r), air data including at least speed, altitude and angle of 
attack as well as heading information, characterised in that the arrangement includes an 
integration routine (8) to integrate out the aircraft's attitude from information about the 
aircraft's body-frame angular rates (p, q and r) as well as that the calculated attitude is 
corrected by means of reference attitude from air data and redundant heading. 

1 1 . Arrangement according to claim 10, characterised in that the heading information is 
obtained from a heading gyro. 

12. Arrangement according to claim 10 or 1 1, characterised in that integration routine 
(8) integrates out the aircraft's attitude from the aircraft's body-frame angular rates (p, q and r) 
obtained from the aircraft's body-frame angular rate gyros. 

13. Arrangement according to claim 12, characterised in that the integration routine (8) 
is fed with the zero-error-compensated body-frame angular rate gyro signals. 
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14. Arrangement according to claim 10, characterised in that a reference attitude is 
calculated with air data information as well as redundant heading information. 

15. Arrangement according to claim 10, characterised in that a synthetically-generated 
corrected attitude is obtained by generating a difference between the attitude obtained from the 
integration routine (8) and an error signal that represents the error between the integrated 
attitude and the reference attitude, 

16. Arrangement for synthetically calculating redundant attitude and redundant heading 
for an aircraft with the aid of data existing in the aircraft such as measured body-frame field 
vector components, the aircraft's body-frame angular rates (p, q and r) as well as air data 
including at least speed, altitude and angle of attack, characterised in that the arrangement 
includes a first measurement routine (10) which transforms the measured body-frame 
magnetic field vector components to the aircraft's navigation system (navigation frame), a first 
filter (11) which estimates the errors in the calculated measured body-frame field vector 
components, an integration routine (20) for integrating out the aircraft's attitude and heading 
from information about the aircraft's body-frame angular rates (p, q and r), a second filter (22) 
for estimating the errors arising in attitude and heading obtained in the said integration and a 
second measurement routine (21) for calculating attitude and heading from air data and 
derived measured body-frame magnetic field vector components. 

17. Arrangement according to claim 16, characterised in that the first measurement 
routine (10) is fed with the measured body-frame magnetic field vector components, as well as 
attitude and heading from the aircraft's normal navigation system and transforms the measured 
body-frame magnetic field vector components to the aircraft's navigation frame. 

18. Arrangement according to claim 17, characterised in that the first filter (11) is fed 
with information from the first measurement routine (10) and estimates the errors in the 
measured body-frame magnetic field vector components. 
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19. Arrangement according to claim 16, characterised in that the integration routine 
(20) integrates out the aircraft's attitude and heading from the aircraft's body-frame angular 
rates (p, q and r) obtained from the aircraft's body-frame angular rate gyros. 

20. Arrangement according to claim 16, characterised in that the second measurement 
routine (21) is fed with air data, the derived measured body-frame magnetic field vector 
components and with information about the aircraft's body-frame angular rates (p, q and r) and 
from these values calculates an attitude and a heading. 

21. Arrangement according to claim 20, characterised in that the second filter (22) is 
fed with information from the second measurement routine (21) and estimates the errors in 
attitude and heading as well as zero error in body-frame angular rate gyro signals and residual 
errors in the measured body-frame magnetic field vector components for generating an error 
signal. 

22. Arrangement according to claim 21, characterised in that a synthetically-generated 
corrected attitude and heading are obtained by generating a difference between 

- the attitude obtained from the integration routine (20) and heading and 

- the error signal from the second filter (22). 

23. Arrangement according to claim 19, characterised in that the integration routine 
(20) is fed with body-frame angular rate gyro signals compensated for estimated zero errors. 

24. Arrangement according to any of claims 16-23, characterised in that the first filter 
(11) and/or the second filter (22) consists of a Kalman filter. 
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